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ABSTRACT 


Adaptive compliance control of a single robotic Joint was studied to control the 
amount of torque applied on an object by an end effector, which 1s actuated by an 
electric motor through a gearbox. 

For this reason, an adaptive control svstem was designed. Variation in stiffness and 
compliance was observed by simulating the system with МАТКТАраскаве program. 
After observing theoretical variation of the stifíness and the compliance, experiments 
were done to observe and prove the stiffness control theory. 

The proved theory was then applied to a robotic finger jomt actuated by a small 
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I. INTRODUCTION 


One of the most important problems in robotics is the design of a dextrous end 
effector. A dextrous end effector is a kind of gripper or a tool that enables a robot to 
hold or handle different kinds of objects easily and skillfully, hke a human being. Dif- 
ferent techniques can be used to give that kind of ability to the end effector. Two of 
those techniques are direct drive and indirect drive. Jn mdirect drive, the fingers of the 
dextrous end effector will be driven by tendon cords which are actuated by electric mo- 
tors tnstalled into the arm. In direct drive, the fingers are actuated by electric motors 
installed directly into the finger itself. Unfortunately, many actuators are best suited to 
relatively high speed and low torque, therefore they require a speed reduction system 
which is usually a gearbox. 

In today’s automated machinery, reliabilitv 1s an important factor. Since reliability 
decreases with increasing complexity, it 1s better to try to keep the end effector simple 
in both its design and function. The maim source of complexity in dextrous hand design 
comes from the finger joints. In Figure 1, tendon cord controlled dextrous end effector 
Is shown. As can be seen from the figure, pullevs and the tendon cords used to actuate 
the fingers presents a considerable amount of complexity. 

In a tendon cord design, the designer must consider the tension of each tendon, since 
any slack will cause a problem. After gripping an object, the power on the tendon cords 
must be kept to maintain a grasp on the object. Another problem will be the werght of 
the hand. Since the weight of the hand and the arm is increased bv a tendon cord and 
pulley svstem, this will cause problem imn arm joint (elbow) and shoulder joint designs. 

Bv using a direct drive method in the finger joints, the difficulties listed above can 


be overcome to some extent. Dv installing DC servo motors directly to the finger joints 





Figure I. Tendon Cord Controlled End Effector. 


as shown in Figure 2, the finger links can be nioved without tendons. The weight and 
keeping the power on after the grp will not be a problem. If the motor drives the joint 
through a high ratio gearbox, power may be removed from the motor, and the small 
amount of armature friction will prevent the motor from being backdriven. This means 
that a grasp is maintained with power removed. Since the complexity of the joint will 
be less, the reliability ef the system will be higher. By using a gearbox to transmit the 


motor torque and installing the actuators directly ito the finger, this system provides 


torque multiplication and increased position resolution which are very critical properties 
in tlie successful design of robot joints. 

Although having a joint nonbackdriveable 1s an advantage, there are disadvantages, 
for exanple in handling delicate objects where a relatively large compliance in the finger 
joint 1s desirable. 

In a finger joint a direct drive element must therefore carry out two tasks. 1. lt 
should be able to bring the joint to the desired position, and 2. after contact with an 
object it must provide enough grip to hold or to manipulate the object without breaking 
1. 

Therefore our system must have two characteristics. lt must provide position control 
and necessary torque without breaking the object. While position control is enough to 
provide à desired trajectorv, when contact is made between the end effector and the ob- 
ject. position control mav not be sufficient. 

Contact force apphed on an object will be the major problem with the direct drive 
end effector. The contact force applied by a direct drive end effector on an object will 
be decided by tlie stiffness of the servomechanism used to actuate the joint. Usually 
servomechanisms have high natural stiffness due to the high gear ratio. This may cause 
some problems when manipulating fragile objects. This problem may be overcome by 
changing the stifIness of the system for certain tasks. Stifíness of the servo system will 
be defined as 

ТЕ! (1.1) 

о 
Where т, = the disturbance torque applied to the output shaft and @,= the angular 
displacement of the output shaft. Bv changing the stiflness of the system, torque applied 


on the object can be controlled. The inverse of stiffness, namely 
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Figure 2. Direct Drive End Effector 


--- (1.2) 


will be defined as compliance of the system, 
The purpose of this research is to design a simple system that will provide both po- 
sition control and torque control, and by changmg the stiffness of the servo system to 


be able to control the applied torque on the grasped object. 


The thesis consists of eight chapters. Following the introduction, chapter 2 presents 
the theorv of stiffness and compliance control. The third chapter is devoted to system 
parameter identification of the experimental system. Simulation results of systém re- 
sponse are presented in chapter four. The fifth chapter is devoted to experimental 
suffness control of the. svstem. while chapter six discusses the adaptation of stiffness 
control to a prototype finger configuration. Following the discussion chapter, conclu- 


sions are presented. 


Di 


Н. THEORY OF STIFFNESS AND COMPLIANCE CONTROL 


Interaction between objects and the end effector presents a much more complicated 
problem than position control. When an end effector is moving in a free space, there 
isn't anv constraint, namely it does not touch any object that’s going to constrain its 
motion. When it has contact with an object, a new variable defined as a disturbance 


must be added to the system. 


A. POSITION CONTROL SYSTEM AND STIFFNESS OF A SYSTEM 
1. Standard Position Control system: 

The object in a position control system is to control the angular position of the 
output shaft. The desired position of the output shaft is achieved by a voltage that has 
been generated by means of a potentiometer, as shown in the block diagram in 
Figure 3. The angular position (0,) of the potentiometer generates a proportional bipolar 
voltage according to the potentiometer's transfer function ( Kp ,volts/radian). This 
voltage is compared to the achieved position of the load or output shaft of the motor 
as measured by another identical potentiometer. An error voltage is generated by sum- 
ining these two voltages. Usuallv after passing through an amplifier, this voltage drives 
the motor. This amplifier’s gain is usually called the forward path gain of the system 
(k,). The angular velocity of the motor shaft is obtained after the applied voltage 15 
passed through the motor. Following the motor, there is usually a gear box. Dividing 
motor shaft's angular velocity by the gear ratio, the angular velocity of the motor’s 
output shaft velocity is obtained. Since differentiation of the position gives the velocity, 
by integrating the angular velocity, angular displacement of the output shaft can be ob- 


tained. This angular displacement of the output shaft is fed back to the system to achieve 


desired position. 





Figure 3. Standard Position Control System. 


In the block diagram following constants are used. 
K, = Motor constant (rad/sec, volt) 
К, = Potentiometer constant (volt'rad) 
T, = Mechanical time constant (sec) 
k, = Forward path gain 
N = Gear ratio 
In position control svstems, different kinds of electrical motors can be used, 
although a DC motor has been used in this research. The DC motor 1s a power actuator 
device that delivers energy to a load. DC motors rotate due to the interaction of two 
magnetic fields, one in the stator, one in the rotor. The rotational speed may be varied 
by controlling the strength of one of these fields. The input voltage can be applied to 
either the field or the armature terminals. The air-gap flux of the field current is pro- 


portional to the field current. So that 


ó = Куу (2.1) 


К, = Field constant 
= Field current 


The torque developed by the motor is assumed to be related linearly to @ and 


the armature current as follows 


Та = ХК Фу) = К, KA) (2.2) 


t, = Motor torque 


i, = Armature current 


In order to have a linear element one current must be maintained constant 
While the other current becomes the input current. Two kinds of motor can be defined 
based on this principle, field controlled motor and armature controlled de motor, as 
shown in Figure 4. By taking Laplace, transform of equation (2.2) the following 


equation is. obtained. 


To (5) = (Ai Klas) 7 Ку) (2.3) 


Where A; = Motor constant (Am'amp) 


The field current is related to the field voltage as 


|, = Field voltage 


L Field inductance 


The motor torque is equal to the torque delivered to the load. This relation may 


be expressed as 


Tie Te (2.5) 


ее Lor ogue 
T, = Disturbance torque. 


The load torque for rotating the inertia shown in Figure 4 is written as 


Та (5) = Js 0(s) + /56(5). (2.6) 
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Figure 4. A DC Motor a) Wiring Diagram b) Sketch. 


Rearrangmg equations (2.3), (2.4) and (2.5), the following equations may be 


GLEDE. 





n ESI (2.7) 
Tals) = Ks). (2.8) 
ES 
E 
105) ЕТ» (2.9) 


Therefore, the transfer function of the motor-load combination will be as fol- 


lows 





(2.10) 


The block diagram of the field controlled de motor 1s shown in Figure 5. 
Alternatively, the transfer function may be written in terms of the time con- 


stants of the motor as 


Ку 
Os) [Ry 


i = en Ee (2.11) 
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if J 
ШС = and r = = 
f › Е 
К, Т 
Since usually 7, > c, the field time constant may be neglected. 


The armature controlled dc motor utilizes a constant field current, therefore the 


motor torque may be written as bv 


Т„(5) = (К, КА 1 (5) = Ат14(5). 21) 


The armature current 1s related to the input voltage applied to the armature 


| (5) = (К, + L,5)1,(s) + Fs), (2.13) 
where l,(s) 1s the back electromotive-force voltage proportional to the motor speed. 
Vs) = Kyw(s), [e 14) 
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Figure 5. Block Diagram of Field Controlled DC Motor. 


Fas) = Кро (5) 
L(s) = —(R,+L,8) – (2 


The same load torque equations, (2.6), (2.7) will be valid for armature control 


also. The relations for the armature controlled dc motor are shown in the Figure 6. 


The transfer function of armature controlled dc motor will be as follows 


O(s) _ Kr 


D е (2.16) 
las) LR + Las Is +4) + КУКт] 


. hye . . à 
For many dc motors, the time constant of the armature, t, = R's negligible. 


The resultant transfer function will be as follows 
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where the time constant z = m EK) 
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Figure 6. Block Diagram of Armature Controlled DC Motor. 


2. Effect of load inertia: 

A study of the free body diagram of the motor, gearbox and the load will be 
helpful to write the equation motion of the mechanical part of the de motor in 
Figure 7. 

Since the armature inertia and the viscose friction have to be overcome, all of 
the torque generated (t,) 1s not available at the gearbox input shaft. The general 


equation of motion of a torque generating system may be written as 


y= 0. (2.18) 
{= | 


Considering the gearbox ratio N> I the equation of the motion can be written as follows 


Гог the motor shalt 
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Figure 7. Free Body Diagram of DC Motor. 
Tm ~ 1, — саң -./10)) (2.19a) 
For the load shaft 
T) — C, 0) = J, < (2.195) 


Рог the gearbox 


о), = ae Тә = Ti 
CC OCT OFAC 
J, = Armature mertia 
J, = Load inertia 
w, = Motor shaft angular acceleration 


£ 
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Motor shaft angular velocity 


w, = Output shaft angular acceleration 


Š 
l 


Output shaft angular velocitv 
c, ^ Motor shaft damping 
c, * Output shaft damping 


Referring all variables to the motor shaft gives: 


T 
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In the equation of motion there is an important property 


The effect of the gearbox reduces the load inertia and load shaft 


(2.19c) 


Ы 


that has to be noticed. 


damping factor bv (M. 


This means that, by using a gearbox we may apply less torque to the motor shaft to 
accelerate the load on the output shaft. Another interesting effect of the equation can 
be seen, when the torque is applied to the output shaft to turn input shaft. Then fol- 


lowing equation will apply: 
ти = (А + 3 JO) + (о. У + Jo, (2.24) 


In this equation, the effect of input shaft's inertia will increase by N?. As a result of this 
effect, it will be easier to turn the system in the figure by applying torque on input shaft 
rather than on output shaft. This 1s one of the important properties used in control 
systems design to reject disturbances. 
3. Analysis of the servo system: 
Torque generated bv the armature is linearly related to the current applied. 


Torque generated by the armature is given by 
тм = K+... (2.25) 


Here K, is the motor torque constant with units Nm/amp. This generated torque ac- 
celerates the motor armature itself and an external load. It also overcomes viscous 
damping torque and any external load torque. 

As demonstrated, in the preceding section of the chapter, the load inertia rather 
than motor inertia may be neglected, if N >> 1. The transfer function from motor 
torque t,, to output angular velocity w, is obtained by taking the Laplace transform of 
equation (2.24) and re-arranging in the form. 


0) ] 
RUNE Le. .26 
T Js+c (522 


Where J is the total inertia referred to the motor shaft and c 1s the total damping referred 
to the motor shaft. Both the mechanical and electrical part of the motor gearbox com- 
bination can be seen in Figure $. The complete position control svstem block diagram, 
is now shown in Figure 9. 


The close loop transfer function of the svstem becomes 


0, | T 
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Using w, = As0,, the transfer function of the system can be written as: 


a = —n n (2.28) 
6 y ` 
N Е F k,NR)s+tK 
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RK 


4. Disturbance effect on the position control system: 


where A =k 


The main variable in stiffness and compliance control of a servo niechanism 1s 
the torque applied on the object. This torque must be adjusted according to the dis- 
turbance torque sensed from the object. When an end effector applies a torque on the 
object, the object will applv a reaction torque on the end effector. [his will cause a dis- 
turbance effect on the system. In Figure 10. a sketch of an end effector applving torque 
on an object and the object’s reaction torque are shown. This disturbance torque will 
have a braking effect on the output shaft. The analvsis of the system may proceed in the 
same manner identical to before, except that the equation of the load shaft will be 
modified due to the disturbing torque т, 

Considering the disturbance torque and gear box effects as shown in 


Ligure 11], the equation of motion of the system may be written as follows 


17 





Figure 8. Electrical and Mechanical Part of the System. 


> z, = JÓ. (2.29) 
iz] 
M | ЫЕ | масни 2.30 
ст Ае (Ја + n )Win + (cy + А? Jn (2.30) 


An equation may be written considering total inertia and damping of the sys- 
tein. 
та 


Tm — у = IOm F C Oy. (2.31) 


ty = Disturbance torque 


o, = Motor shaft's angular acceleration 








Figure 9. Position Control System. 


o, = Motor shaft’s angular velocity 


Y 
N Force 






(и e. Pivot Point 
Та 


Ty = Fr 
Figure 10. Free Body Diagram of a Torque Applying End Effector. 


The equation of motion of the system may written as 


UD s S 
< iN s( Js + с) 


Ko 
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Ка 
and represented in block diagram form as shown in Figure 12. 

The transfer function of the system including a disturbance torque and keeping 
0, constant can be written as follows 
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Again using w, = А50,, the steady state response of the system to a disturbance 


torque IS: 
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Figure II. Free Body Diagram of Motor Shaft With Gear Box and Disturbance. 


0 R 
ТЕ u Kakpo KT Cee) 
An indication of the svstem stiffness can be seen when one tries to turn the 
output shaft of the system by hand. The system will show a resistance to the hand, 
opposite to the desired rotation. The resistance is caused by the voltage gencrated by 
the output shaft’s potentiometer. As stated above, this voltage will be fed back to the 
system) as a negative signal, meaning that, the motor will generate a torque opposite to 


the torque applied to the output shaft by the hand. ‘The ratio of rotation to torque, 


given in equation (2.35) is the stiffness of the servo. 
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Figure 12. 





Position control system with disturbance. 
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There are four values which may help to change the system’s stiffness. These 
can be seen in equation (2.35). In this equation only A can be changed. As &, increases 
stiffness of the svstem will be increasing. K;, R can not normally be changed, because 
they are particular values which are fixed by the motor. Changing the value of A, can 
be considered, but it is not going to be a very good option, since this gain easily may 
make the system unstable. For this reason, another way of changing the stiffness must 


be considered. 


B. COMPLIANCE CONTROL STRATEGY 
1. Description of how stiffness may be changed: 

Suppose that ] Nin. disturbance is applied to a servo system and | rad. rotation 
of the output shaft is observed. This means that the stiflness of the system is 1 Nin rad. 
If a higher rotation is desired bv applying the same torque, the stiffness of the system 
will be lower. Namely, instead of 1 rad. of rotation, for example, 5 rad. of rotation is 
observed: Therclore, the stillness of the system will De 0.2 Nin rad. 

To be able to control the amount of torque apphed on the object after contact, 
rotation of the output shaft must be controlled. 

Since the voltage applied to the inotor causes the rotation of the output shaft, 
by increasing the amount of voltage going to the summing junction before the motor. 
rotation of the output shaft can be increased. This will cause additional rotation of the 
output shaft for the same torque. Therefore the suffness will be decreased. The new 


block diagram of a svstem which has variable stiffness abilitv is presented in ligure 13. 
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Figure 13. Position Control System With Disturbance Feedback. 
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The measured disturbance torque 1s fed back to Ше зшипипе junction before the 
motor. Dv passing the measured torque through a variable gam E, we will be able to 
control the amount of additional rotation of output shaft. 


The new equation of motion of the svstem will be as follows 


Ky 5 
ee ae Og kalOik por ~0oKpor - гаЕ)). (2.56) 
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do 7 Ns(Js + c) 


Keeping 0, constant, the following transfer function of the system can be ob- 


tamed. 
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Steady state output of the system, assuming А, = 1 will be 
E Er + | 
0, R 
pom M cm (2.38) 
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where isum volts ` m. 
2. Stiffness as a function of gain E. 
То demonstrate the variable stiffness and compliance in a servo system, E and 
mirare assumed to be positive in equations (2:50), (2:37), (2.38), Thus the following 


equations were obtained as a transfer function of the svstem. 
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This is defined as the compliance of the system. The stiffness is the inverse of compliance 


as shown in the following equation. 


k Sy 
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As can be seen in equations above, the only variable 1s E. Therefore bv changing E, the 


stiffness of the svstem may be changed. 


r 


T š : : 
г. аше TR. arbitrary values, the suffness and the compliance curves 


were plotted, as shown in Figure 14 and Figure 15. The compliance of the system will 


By giving A 


be directly proportional to E. Since the stiffness of the system is the inverse of the 
compliance, the stifIness of the svstem will be inversely proportional to E. At the same 
ume rotation of the output shaft will be directly proportional to E. The potentiometer 


constant will deternune the slope of the curve. As K 


pot 


increases, the slope of the com- 
phance curve will be decreasing. When E is zero, the stiffness of the system will be 


equal to it's natural stiffness or original stiffness. 


C. EFFECT OF EFFICIENCY OF A GEAR TRAIN: 

Another problem which has to be discussed, concerns the disturbance torque. Ac- 
cording to the gear theory, as presented in equation (2.19c), the disturbance applied to 
output shaft has to be divided by the gear ratio N to refer it to the motor shaft. 

Efficiency of the gear train is another important effect which has to be addressed. 


It is defined as the ratio of the output power to the input power, or the ratio of the work 
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Figure 14. Compliance Variation of a Servo System. 


output to the work input over the same period of time. For an ideal mechanism, it will 
be 100 % or 1. In reality, a normal gear train will dissipate some of the power which has 


(onbetraiismiutied, Ieticiency ean be written as: 
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Figure 15. Stiffness Variation of a Servo System. 


power ош 


С (2.42) 


power in 


In the case of the gear train, it has to be restated, because there is a gear train ratio. 


The new equation will be as following 


actual output torque | E 
= Ри s s (2:45) 
input torque N | 


Ihe efficiency of transmission can be determined by measuring the resulting torque 
on the output for static torques apphed to the input shaft. 

The efficiency of anv mechanical device will become significant with robot end 
effectors actuated by motors driving through high ratio gearboxes. It is no longer safe 
to assume that the output loads are reflected to the input shaft by a function of the gear 
ratio, since anv efficiency less than | will increase the torque required to accelerate a 
given mertial load or overcome an external torque. It is also important to notice that the 
efficiency of the gear train does not affect the actual transfer ratio of the gears in terms 
of displacement, velocity or acceleration, but greatly affects anv torque related property. 
Efficiency 1s dependent on such factors as the coupling ratio, the material s coeflicients 
of friction, and the angle used to define the gear teeth or the depth of cut and type of 
Heads lor Screws. 

Another interesting effect of efficiency is on the gear train’s backdrivabhtv. 
Backdrivablity is the ability of a gear train to transmit the torque or the disturbance 
that has been applied on the output shaft side of the gear system, to the motor or to the 
torque source as shown im Figure 16. 

In general as the efficiency. goes higher, the backdrivablity will be higher, i.e the 
system is more likely to be backdrivable. At the same time a gear trains efficiency may 
bosdillerent for each side. [For example m the case of worm gears, it will be zero for 
transmission of the torque from the load to the motor. Sometimes this property 1s good 
in robotics application, because it will help rejection of the disturbance torque, which 


may be a gravitational or frictional torque. 
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Figure 16. Transition of the Disturbance Torque to the Motor. 


At the same time, nonbackdrivablity will influence system stiffness, because the 
transfer function of the system will change. 


The new equation of motion of the system will be as follows 
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Keeping 0, constant, the following transfer function of the system can be obtained. 
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Steady state output of the system, assuming k, = 1 will be 


0 
To (2.46) 





The stiffness of the system will be 


30 





A ? (2.47) 


If positive feedback 1s used, the system stiffness will be positive infinite When E goes to 
zero. As E. is increased, the stiflness of the svstem will decrease as shown in Figure 17 
and Figure 18. 

The effects mentioned above must be considered in our model in order to obtain 
high accuracy. Therefore as one can see from Figure 19, two new variables are added 


forthe system. [hese are: 


K = Nonbackdriveability constant 

у = Efficiency of the gear tram 
Where, K = 0 (nonbackdriveable) 

Or K = | (backdriveable) 


for backderiveable svstems. Again keeping 0, constant, the new transfer function, 


compliance and stiffness of the svsten) will be as follows 
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Figure 17. Stiffness Variation of a Servo System (nonbackdriveable). 


The important conclusion drawn from the above discussion is that the system may 
have a finite stiffness bv using disturbance feedback through L even though the original 


system was not backdriveable, corresponding to infinite stiffness. 
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Figure 18. Compliance Variation of a Servo System (nonbackdiiveable). 
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Position Control System Including Efficiency and Backdrivability. 


ПІ. SYSTEM PARAMETER IDENTIFICATION 


Electric motors used with end effectors or robotic finger joints, are usually small 
motors, hence, it 1s difficult to observe the variation in the compliance and the stiffness 
of these kind of systems. It is also difficult to measure certain parameters ехрег- 
imentally, therefore, a larger servo system was used to observe ard to prove compliance 
theory. 

A feedback ES151 educational servo system, together with suitable test equipment 
was used to prove compliance and stiffness theory. This 1s a high quality electro- 
mechanical servomechanism, consisting. of three basic units: actuator unit, educational 
servo unit and accessories and spare parts as shown in Figure 20. 

The actuator unit is essentially a 24 v electric motor unit, a tachogenerator, gear 
box, output disc and a potentiometer. 

The educational servo unrt 1s the control unit of the system. It contains all the nec- 
essary power supplies for the system to operate. The main parts of this unit are com- 
mand tmput, control circuits, preamplifier, servo amplifier, schematic of the actuator 
unit, current meter and on, off switch as shown in Figure 21. 

The ES151 educational system is built for standard position control. The block di- 
agram of the general system as a standard position control system 1s shown in 
Figure 22. As can be seen from the block diagram after, applving a voltage to the mo- 
tor, an angular velocity of the motor shaft is obtained. Dividing motor shafts angular 
velocity by the gear ratio, the output shaft angular velocity 1s obtained. Integration of 
this angular velocity gives position of the output shaft. Voltage obtained by using an- 
other potentiometer attached to the output shaft, fed back to the svstem as a negative 


signa]. The suin of two voltages gives an error voltage which drives the motor. Finally 
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Figure 20. 
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Figure 21. Educational Servo Unit. 


the output shaft angular displacement will be the same as input displacement introduced 
to the system by using command mput. 

In the block diagram the followmg constants are used. 
K,= Motor constant (rad/sec/volt) 


5 


k. = Potentiometer constant (volt/rad) 


k,= Back end constant (volt/rad/sec) 


T Mechanical time constant (SEC) 


12 





Гірше 22. Block Diagram of Educational System As a Standard Position Control 


system. 
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k,= Control amplifier constant (forward path gain. servo amplifier gain) 
k, = Power amplifier constant 

The main difference between this diagram and the standard position control svstem 
diagram, which was presented in chapter 2, 1s &, This constant gam rs added to the 
system to increase the voltage going to the motor. It amplifies the potentiometer's out- 
put Voltage and matching it to the DC motor. The procedure for finding these constants 
experimentally 1s a standard laboratory exereise (ME 3802) and presented in appendix 
A. Estimated values of these parameters are as follows 

пао Оре а се volt: ( when ZO?) 

po Kk, — 0.0022 volts rpm 

S7, OlUS rad: 

Гь = 0.25 sec. (open loop time constant) 

anges Ew T 

As stated at the beginning of the chapter, the main reason for using this system Is 
to experimentally prove the compliance and stiffness theory previously discussed. The 
block diagram for the ES151 system 1s somewhat different from that used in the devel- 
opment of the theory of variable compliance - see Figure 22 and Figure 23. For this 
reason, conversion of the identified parameters to those necessary to determine the 
stiffness are necessary. The followmg equations indicate the equivalence of the parame- 
ters. As can be seen from the figures, a new variable k, 1s added to the both systems, 


m order to match educational systems block diagram with position control systems 


block diagram. 
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Figure 23. Block Diagram of Position Control System., 
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Кс 


K,= Motor torque constant (Nm, Amp) 


R = Resistance (olim) 


| 


=F otal mertia CNnisec* 2 тад) 


c = Total damping (Nm sec’rad) 

Ju а дато (5 Рута (32) the valve of Y. and A are known. Pherefore, the value 
of c can be found after finding the value of J. The value of J may be found by performing 
a torsional pendulum experiment. 

1. Torsional pendulum experiment: 

This experiment requires a collet, a piece of wire with known modulus of ri- 
gidity and a stop watch. The armature of the motor is taken out and attached to the wire 
by way of the collet. Then the wire is attached to a fixed support where armature’s free 


movement can be observed, as shown in Figure 24. A half twist is given to the armature 


and allowed to oscillate freely. The equation of motion of the system will be as follows 


J0 + K0 = 0 (ШІ 
J = Moment of inertia of the armature. 
K = Torsional stiffness of the wire. 
The angular frequency of the system will be as follows 
К " 
С) == СК 3.4 
V J 


w = Angular frequency of the system. 
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K 

Jhon g = 

C) 

To find the angular frequency of the svstem, time was recorded for ten oscil- 
lation of the armature. Dividing the time by number of oscillation gave the period of the 
motion in sec cvcle. Then. it was converted into angular frequency in rad‘sec. The 
stiffness of the wire was calculated by using following formulas. 
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G = Modulus of ngidity. 


Where /= 


1 = Length of the wire. 
d = Diameter of the wire. 
J = Torque. 
The measured dimensions and properties of the wire were: 
d — 2.5JE-4 m I7 0.61595 m 
G = 40 Gpa. 
The following results were obtained: 
T 


w= 1.239rad/sec К = Fa 2.65E — 5Nm]rad. 


so = 1706 و‎ 
rad 


Since, J is now known, the value of c can be calculated bv using following 


equation. 


J ]l.726E — 5 Nm sec 
Cx A A p E <a TI ڪڪ‎ с=ш= sf کک‎ Sa — 15 
г (аи ORS сер rad. e 


K 
After finding the value of c, the only unknown will be 2, This value may be 


found by perfornung a speed-torque experiment. 
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Figure 24. Torsional Pendulum. 





2. Speed-Torque Experiment: 

When a constant voltage 1s applied to the motor terminals, the motor shaft will 
accelerate and attain a final steady state velocity. This may be explained mathematically 
by using open loop block diagram of the position control system in Figure 25. 

The equation of motion of the system will be as follows 


| Га Kr 2-7” 
S "V tog Cael s Кроа) J (3.6) 


Ot 


Steady state response of the system into a step input as disturbance with con- 


stant I, will be 
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Figure 25. 





Open Loop Speed Control Systen:. 
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t 


an equation ofa straight line, which may be written as 


| 2—mXVX--C (579) 
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Here, m is the slope of the curve and is equal to ( 
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this curve will have a negative slope. When a constant V, applied to the terminals of the 


motor without a braking or disturbance torque, w, Without load will be obtained and 1s 





k 
known as the no-load speed. This point will be X = Об у = p Г . When the 
b 


braking or disturbance torque applies enough torque to stop the motor, (-mX) will 
equal to C. This point will be Y20 & X27 t, on the curve and is known as the stall 
torque of the motor. This curve is shown in Figure 26. Since two points are known, the 


line can be drawn. To get necessary data, the following procedure mat De carried out. 
l. Establish a constant voltage. V, 
2. Calculate the value of K KK. 


3. From no-load speed calculate А, 


F 


4. From slope calculate E 


However, the braking torque can not be applied directly to the output shaft in 
the educational svstem, because of the gear box has a worm gear in it. As discussed in 
chapter 2, this means that svstem is nonbackdriveable and the motor can not be stopped 
bv applving the braking torque directly to the output shaft. That's why, the braking 
torque is applied to the motor shaft, so the value of .V' becomes 1 and the speed torque 
test is performed on the motor shaft, rather than on the output shaft. 

After establishing a constant angular velocity, V, was measured and found to 
be 0.43 volts. 

Before applying the voltage to the dc motor there are two amplifiers. As stated 


above these are controller amplifier and power amplifier as shown in Figure 27. To find 
Ж 





К. V, and V, voltages are measured. ҮДЕ ratio of these two voltages, namely 7 
k,. After measuring V,. the ratio of — will give k, 


gives 


From the ratio of =. the value of K, may be calculated. Where, V, 1s the 
input voltage to the motor and wy; is angular velocity of the motor shaft under no-load 
conditions. 

Braking torque is applied to the motor shaft by attachıng a torque lever arm to 
the motor shaft. A scale was put under this arm to measure the braking torque applied 
to the motor shaft. When the angular velocity of the motor shaft was zero, the scale 


showed 40 grams. The braking torque was found to be 
D EE (3.10) 


Where, W = (40,1000)kg * (9.81 — 0.3924 N (lifted weight) and L = 0.224 
m.(length of the arm). After multiplying W by L, the value of 7, was found. Then, the 
value of t; and wp; were plotted on the speed/torque diagram. The results of the exper- 
iment may be summarized as follows 

Measured data: 

V, = 0,43 volts 

V, — 0.206 volts 

F. = 8.45 volts 

Derived data: 

k, = (0.206 0.43)= 0.48 
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ligure 26.  Speed- Torque Curve. 


k, = (8.45/0.200) = 4| 
k, = (8.45/50À10)volts/rpm- 1.67L-3( volts/rpm) 
Hence finally 
E 5 0.01 Nin/volts 
R mk, 


The experimental speed/torque curve for the motor ts shown in Figure 28. 
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Figure 27. Power and Control Amplifier Block Diagram 


Now that all parameters in the block diagram in Figure 23 have been identified, 


the system may be simulated in order to observe its steadv state and transient response. 
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Figure 28. — Experimental Speed-Torque Curve. 
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IV. COMPUTER SIMULATIONS 


Before performing experiments on the model, variation of the stiffness and com- 
pliance were observed by simulating the system with the MATRIX, package program. 
Also, the system response to different kinds of inputs and the resulting transient re- 
sponse were observed. 

As stated in Chapter III, the ES151 educational system has a worm gear in the 
gearbox, therefore the natural stiffness of the system was infinite. This means that. ro- 
tating the output shaft bv using a disturbance torque, without feedback from the dis- 
turbance torque, was impossible. But this does not mean that motor shaft also has 


infinite stiffness. The following equations may give a better view of this situation. 





Пе aap еее ; 
К, = 0, оо. (4.1) 
SICH O0 =O 
However, 
K, = — = co (4.2) 
D 


and therefore it is A, which will be simulated. 


K, = system output stiffness. 


о 


K. = motor shaft stiffness. 


т 


0, — motor shaft angular displacement. 


m 


0, — output shaft angular displacement. 


о 


Since, the disturbance torque is applied directly to the motor shaft, the gear ratio, 


the efficiency and backderiveablity constant will all be unity. The system block diagram 


with gear ratio equals to one, including the parameters found in Chapter III], without 


feedback froin the disturbance torque is shown in Figure 29. 


As can be seen from the block diagram, a step disturbance was applie directly to the 


motor shaft. and @, is assumed to be constant. 
Шемен стер оне О Ге 30 (¢ = 1) Figure 3J (2 | jedi 4s 


seen to be that of a second order system. 
Using the following formulas svstem characteristics may be found in terms of : 


P.O.= Percent overshoot 
T, = Peak time 
¢ = Damping ratio 


I, = Settling time. 





b= (4.3) 
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(M ise 
Р.О. = 100€ 7 5. (4.4) 
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The transfer function of the svstem including tlie disturbance torque, А, апа keeping 


0, constant can be written as follows 
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Figure 29. The Block Diagram of tlie Model With Unity Gear Ratio and Without 


Feedback From the Disturbance Torque. 
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COMPLIANCE OF THE MOTOR SHAFT VS TIME 





Figure 30. Step Response of the Motor Shaft, ¢< 1. 


Again using w,, = Ns@,, the steady state response of the system to a disturbance 


torque is: 
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Figure 31. Step Response of the Motor Shaft, # > 1. 


So, the stifíness of the system will be 
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(4.8) 





Equation (4.6) may be approximated into the form of a regular second order transfer 
function. i.c. 
(07 
i í (4.9) 
У РОС У РО, 

To be able to get an ideal transient response, the dampmg ratio of the system must 
be adjusted. Having a P.O. close to O will provide the ideal transient response. For this 
reason, € or w, (natural frequency of the system) must be changed. The only variable 
in the system which can be effective in optimizing these values is k, As can be seen in 
equation (4.6), this value also effects the stiffness. To be able to obtain the optimum 
gain of k, for ideal transient response and observe it is effect on the stiffness, the system 
was simulated with different values of K,. It was observed that when 0.87 < k, < 0.91, the 
system had the ideal transient response as shown in Figure 31. The system response 1s 
presented in the form of compliance and as can be seen from the figure the steady state 
response of the system was as predicted in equation (4.7). But, it must be noticed that 
simulation gives us the compliance as measured at the output shaft, not the motor shaft. 
therefore, the result must be multiplied by the gear ratio which 1s 30 in this case. The 


inverse of this value gives the stiffness of the motor shaft. 


0, NR 


Та ni Kap nop p 





(4.10) 


where, 0. — 0. N. 
Before designing and putting together the necessary experimental system, the effect 
of the gain E on the system transient response must be determined, therefore, the torque 
feedback as presented in the theory section was added to the system. After adding this 


feedback, the system stiffness miay be changed from infinity to a finite value. Since, the 


Сл 
сл 


system is nonbackdiriveable, K 1s equal to zero. The complete svstem, with E=1 and 
K =0 is as shown in Figure 32. 

The system was simulated by varying the gain E. It was observed that adding the 
torque feedback and changing the values of the gain E did not effect the transient re- 
sponse of the system. It was also observed that the variation of stiffness and the com- 
pliance was as predicted earlier in the theory section. To be able to obscrve the effect 
of backdriveablitv, the system was simulated with K 7 1 and efficiency equals to 0.95. 
These did not effect the transient response of the svstem either. 

As a result, by changing the value of A, system transient response can be adjusted 
and ideal value found to be 0.89. Adding the gain E, k , 7 to the svstem did not effect 
the transient response. The steady state response of the system also agreed with that 
predicted. It is concluded therefore that the system transient response and stiffness are 
independent, as may be shown from the complete transfer function (0, = constant) for the 


system im Figure 32. 
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V. EXPERIMENTAL STIFFNESS CONTROL 


A. NATURAL STIFFNESS OF THE SYSTEM 

As presented in the preceding chapters, every position control system has its own 
natural stiffness. One can feel the stiffness of the system when the output shaft is ro- 
tated. When we tried to rotate the output shaft of the educational system, it was ob- 
served that neither the output shaft nor the motor shaft rotated. Therefore, it was 
observed that the stifíness of the educational system was infinite. But when we tried to 
rotate the motor shaft, we felt the stiffness of the shaft. The stiffness felt at the motor 
shaft was verv small, Therefore, it was not possible to measure it by attaching a lever 
arm to the shaft directly. The stiffness was not even enough to lift the weight of the lever 
arm. On the other hand it was enough to stretch a thin regular rubber band. Therefore, 


the stiffness of a DC motor shaft mav be found by using a low force rubber band as a 
spring. 


B. STIFFNESS TEST 

For this experiment, a regular rubber band, a protractor, a ruler and two different 
Weight units were used. The rubber band was attached to a fixed support where different 
Weights can be applied. Then 0.25 1b.(0.1134 kg) unit applied to the band. Extended 
length of the band was measured and it was observed to be 4.8 in. (0.12192 m). When 
0.50 lb. (0.2268 kg)was applied, the amount of stretch was 6.8 in. (0.17272 m). The 
stiffness curve (weight vs amount of stretch) was plotted by using these two measure- 
ment. The best fitting curve's slope gave the stiffness of the rubber band. The stiffness 
curve of the band is shown in Figure 33. Since, the stiffness of the rubber band 15 
known, the amount of force applied by using this band may be found from the stiffness 


curve of the band or bv using the following formula. 


58 


F= KN (5.1) 


Where, K = The stiffness of the band (the slope of the stiffness curve) and 


N = Amount of stretch of the band. 


lf the applied force is known, torque mav be found by multiplving the force bv the 


moment arm. 


т= ГІ. ( 


Сл 
tJ 
N” 


Where, L = Moment arm. 


The protractor with a small screw on it was mounted to the motor shaft. The rubber 
band attached to the screw and stretched ensuring there was 90 degrees of angle be- 
tween the rubber band and the moment arm as shown in Figure 34. Then, the amount 
of stretch m the rubber band length and the rotation of the shaft was measured. The 
following results were obtained: 


N = Sin. (0.127 m), rubber band extension. 


L 


1.75 in (0.02135 m). moment arm. 


0, = SÓ degrees (1.4 radian), measured rotation of the motor shaft. 





F = 1.226 N (from the curve using 5 in. extension), applied force. Then, 
t= 1.226N x 0.0445 = 0.055Am. (5.3) 
So, the stiffness of the system was 
Т 0.055 Nm : Ат 5 
== 0.039 5.4 
Б. 1.4 ғай ғаа. (5-4) 
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Figure 33. The Stiffness Curve of the Rubber Band. 


After the stiffness of the motor shaft was found, theoretical value of stiffness was 
calculated using the following equations. 
The stiffness of the system, keeping 0, constant, with N’ = I and using equation 


(4.6), may be written as 
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Figure 34. Application of the Rubber Band to the Motor Shaft. 


KR UR 
tq ap por 1. 
=- 1 (5.5) 


eaters m | о 
се 0 = ү Phen the stiffness of the motor shaft will be 
N 


Ta Fh por б 
0 RN | 


т 


0 „ = Angular displacement of the motor shaft. 
The measured values were 


k, = OAS 


a 
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= 0.0P (C vok) 


КІ 
N = 30 
b = 57 volts 


pot 


rad 


ЗОНЕ ево Бе 


а _ 0.48х41х001х5.7 _ Nm 
"x "OUI > 0.037 s (5) 





When equation (5.7) and (5.4) were compared, it was observed that the percentage 
error was 5.4 %. So, it was concluded that the theoretical value of the natural stiffness 
of the motor shaft matched with the one found by performing the rubber band test. 

After finding the stiffness of the motor shaft, the variation of the stiffness of the 
system with the feedback gaim E, may be observed and compared with the theory. The 


stiffness variation experiment may be performed to observe the variation of the stiffness. 


С. STIFFNESS VARIATION EXPERIMENT 

The disturbance feedback svstem was designed by using an aluminum lever arm, two 
suain gages, an amplifier, a protractor, a voltmeter and weight units. 

Two strain gages were mounted on the site which 1s the closest point on the beam, 
to the output shaft. so as to be able to measure maximum strain. Also one strain gage 
was mounted top side and the other was mounted on the other side of the beam to be 
able to get maximum voltage as shown in Figure 35. 

The bean) was mounted on the output shaft as shown in Figure 35. The voltage 
obtained from two strain gages was fed back to system through an amplifier. The 
voltmeter was connected to the system to be able to measure and observe the value of 
the gain E. The amplifier provided us the ability to vary the gain E. The protractor was 


mounted on the motor shaft as in the rubber band test. The value of the gain E was 
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Figure 35. The Stiffness Variation Test. 
changed by using the amplifier. After setting up the amplifier for certam values of tlie 
as shown in Figure 35. Again the multi- 


gain E, the beam was loaded with the weights 
arm as presented in equation (5.3) gave the ap- 


plication of the weight by the moment 


phed disturbance torque. The disturbance torque was calculated for two different 
weights. One set of data may be obtained by using the following method. 

The gam E was adjusted to be 2 (volts/Nm). The beam was loaded first with 0.25 
tb.(0.1134 kg), then with 0.50 Ib. (0.2268 kg) respectively. For each load the rotation of 
the motor shaft recorded. As can be noticed , the rotation was recorded for the motor 
shaft, not for the output shaft, because, it was easier to measure the rotation at this 
point. Then the apphed disturbance torque was plotted against the rotation of the motor 
shaft for the two measurements as shown in Figure 36. The slope of the straight line 
gave us the stifíness of the system at the motor shaft. After obtaining necessary meas- 
urements, the stiffness of the motor shaft 1s converted to the stiffness of the system by 


using following formulas. 








(5.8) 


The procedure may be summarized as follows. 


Table 1. EXPERIMENTAL DATA. 


Load Torque, r; Motor Shaft Rotation, 0,, Strain gauge voltage. 


0.228 Nm 3.157 rad. 0.456 volt. 


0.456 Nm 6.6667 rad. 0.912 volt. 





As can be seen above 


_ 0.456velt  . volts 
E 0.228Nm — Nm (59) 
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LEGEND 
о = SLP=2.05NM/RAD(FOR OUTPUT SHAFT) 
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Figure 36. The Stiffness Curve. 
and from the plot the slope was 6.6366 E-2 (Nm / rad). The stiffness of the motor shaft 


Was 


та 
0 





ОСА 0024 (5.10) 
rad 


о 


The above procedure was repeated for several values of E, and the corresponding 


sufIness determined. The results are summarized in table 2. 
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Table 2. 


EXPERIMENTAL RESULTS. 


E(volt/Nm) Stiffness (Nim/rad) 
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VI. ADAPTATION OF STIFFNESS CONTROL TO FINGER SYSTEMI. 


We have proven experimentally that we can vary the stiffness of a position control 
system by means of the torque feedback. We now apply this concept to our original goal 
of attempting to varv the stiffness of a single finger joint of a robotic hand . The problem 
Is exactlv the same as the one previously described, except that the motor characteristics 
are different and the motor used in the joint is smaller. Therefore, we may control the 
finger joint by using the same methodology used in the preceding chapters. The motor 
used in this research and its characteristics are shown in Figure 37. Some of the pa- 
rameters may be obtain from the catalogue [Ref. 1]. These are : 


A; = 3.2 mNm,A (0.453 oz-in/ A) 


К = 26 ohm 

J = 0.03 E-7 kgn? 
L, = 7 msec. 

i] = 0.6 

2, - 302 


10 volts may be considered as a typical voltage that can be applied to a motor ın a 


finger joint. If the potentiometer has 270 degrees of scale, then 


2277 а ПИО 0: SOS: 75 volts | 
ро = 270 degrees Eb degrees rad 


The value of k, mav be found from the following equation: 


L, = = (6.2) 
cr R 
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Figure 37. . M9ISLG61 Electric Motor. 


We can derive the following equation from equation (3.6), (3.7), (3.8). 








RJ 
Га = ae (6.3а) 
Then, 
R. 
k, = Ток (6.36) 


All values in equation (6.3b) can be obtained from the catalogue. So, 


3 volts sec 
rad 
Since, spur gears were used in the system, the system will be backdriveable. There- 


ӨЗДЕ 


fore, K = 1. 


After finding the necessary parameters, we can simulate the system. The block dia- 


gram of the system is shown in Figure 38. The only difference of this system from the 
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educational servo system is &,. We don’t need this gain in the finger joint system. because 
enough voltage can be supplied to the motor directly, but A, can be used in the finger 
system to obtain desired close loop time constant. 10 be able to obtain an ideal transient 
response without overshoot the forward path gain must be 0 <k,< 106. The natural 


stmess of thie svstem. where £, = ] will be 


In equation (6.4) the value of the natural stiffness of the system rs also given as the in- 
verse of the compliance, because again our simulation plot was the system compliance 
vs time. As can be seen from Figure 39, the system has no overshoot. Therefore, the 
system has ideal response and it is suitable for our goal. The svstem was also simulated 
for different values of the gain E and it was observed that the gain E doesn't effect the 
transient response of the svstem as expected. The stiflness variation of the svstem 1s 
presented in Figure 40. 

To be able to adapt the position control svstem presented above to the finger svs- 
tem, the M915L61 electric motor was installed inside a brass case before the finger joint 
as shown in Figure 41 and an aluminum beam was used as a torque measurement svs- 
tem. 

One of the most important parameter which will decide the dimensions of the beam 
for the finger tip was the length and the width of the strain gages. The total length was 
therefore determined to 1.5 em (0.59 in). and the width was 0.3 cm (0.118 in). Two strain 
gauges for each side, a total four strain gauges were mounted on the beam to get maxi- 


mum voltage. The width of the beam was decided to be 0.95 cm ( 0.375 in). The maxi- 


69 





8rt00 0 


9/200 0 





£6 2 ¿6 25 


31р отра 4898 4010ш Uu 13 uje8 ujed pagmaoj 


9/200 0 
85 


56 66 6 3 NIU 3H1 


А1188301804298 01198 8839 АЭМ3121333 








WAS 


21 


4 Н 


he Finger Joint System Block Diagram. 


- 


1 


Figure 38. 
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Figure 39. The Finger Joint Simulation, k, = 3 , E= 0 (without torque feedback) 


mum force can be applied to the beam was considered to be 10 Ibf or 44.48 N. Therefore, 


using the following formula, the deflection of the beam may be obtained. 


a 
EN (6.5) 
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Figure 40. Variation of the Stiffness in the Finger Joint System. 


Where 


Maximum deflection of the beam 


| 


Vmax 


Г Applied force 


| — Working distance of the beam, 2.54 cm. (1 in) 


12 


Pinger tp 





Figure 41. Тһе Finger Joint System. 


E = Modulas of elasticity, for alununum, 71 Gpa. 


il 


I = Moment of inertia, 3.167 E-4 cae. 


b 


Width of the beam, 0.95 cm (0.375 in) 


h = Thickness of the beam, 0.159 cm. (0.0625 1) 

A plot of deflection of the beam for different forces 1s presented in Figure 42. 

As can be seen from the Figure 4], the finger tip is only attached to the beam and 
not to the finger case, therefore it 1s free to move. When the disturbance torque is ap- 
plied to the finger. via finger tip, the beain to which the tp is attached will be deflected. 


So, by feeding back the voltage obtamed from the strain gauges to the system, the 


suffness of the svstem may be changed as presented in preceding chapters. 
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YHS- DISCUSSION 


A. MODELING OF THE SYSTEM: 

The maim goal of this research was to be able to control the amount of torque ap- 
рһеа to an object by a robotic finger which was actuated by a small electric motor 
through a gearbox. The torque applied on an object by the finger can be changed bv 
varying the stiffness of the servomechanism installed into the finger. The stillness vari- 
ation abilitv can be provided to the svstem bv feeding back the disturbance torque 
measured from the object to the system through a variable gain E. 

Since we are mainlv imterested in controlling the torque, the efficiency and the 
backdriveabilty of the gearbox used in the system must be taken mto account When 
modeling the svstem. Ás the efficiency increases the backdriveablitv will be higher, 1.e 
the system will be more likely to be backdriveable. It 1s also important to notice that the 
efficiency. of the gear train does not effect the actual transfer ratio of the gears in terms 
of displacement, velocity or acceleration. but greatly effects anv torque related property. 

Different types of gearboxes can be used in a Servomechanism. Gearboxes with high 
gear ratios can be used to increase the torque applied bv the output shaft. Gearboxes 
with high gear ratios will help disturbance rejection. The effects discussed above must 
be added to the svstem block diagram to obtain an accurate model of the svstem in order 


to control the torque applied on the object. 


B. VARIABLE STIFFNESS CONTROL: 

After adding torque feedback to svstem, the stiffness of the svstem will be a func- 
tion of the gain E and the system will have its natural stiffness when the gain E 1s equal 
to zero. In the nonbackdriveable case, the natural stiffness of the system will be infinite, 


but this does not mean that the motor shaft stiffness will be infinite also. ^s the gain E: 


~J 
“л 


increases, the stiffness of the system will decrease as shown in Figure 43. As the gain 
E increases, the stiffness decreases, the amount of rotation of the output shaft for the 
same amount of the disturbance torque measured, will be directly proportional to the 
gain E. Namely, to be able to obtain a higher rotation for the same amount of the dis- 
turbance torque, the gain E must be increased. 

The variation of the stiffness in a servomechanism was also proved experimentally 
on a larger model. As can be seen in Figure 43, the variation of the stiffness of the sys- 
tem measured experimentally has the same characteristics as predicted theoretically. For 
different values of E, the stiffness of the svstem measured experimentally was lower than 
the ones predicted theoretically. The main reason of this may be the nonlinearity that 
exist in DC motors. Since we are mainly interested in the stiffness variation, the exper- 
imental data proves that our prediction is correct, and that a variable stiffness servo 
system can be constructed. 

As presented before, the stiffness of the educational system was infinite, namely it 
was not possible to rotate the output shaft or the motor shaft bv applving a disturbance 
torque to it due to the nonbackdriveablitv of the. gearbox. After adding the torque 
feedback, it was possible to achieve different stiffness bv varving the value of the gain 
E. Therefore, it is still possible to vary the stiffness of the system even when it 15 
nonbackdriveable. 

Another parameter which effects the magnitude of the natural stiffness in a servo 
system is k, ( forward path gain). As k, increases the natural stiffness of the system will 
increase. We didn't consider using Á, for changing the stiffness of the system because for 
certain values of k, the system may become unstable. Since, k, also effects the transient 
response of the system, after finding the values of k, which will give the desired transient 
response without overshoot, by keeping the magnitude of k, in defined limits, the time 


constant of the system can be changed to a certain value. It was also observed that 
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adding the torque feedback to the system will not effect the transient response of the 


system. 


9g 


C. APPLICATION TO ROBOTIC FINGER SYSTEM: 

Adaptation of the theory of variable stiffness to the finger joint was another im- 
portant part of the research. Since the finger joint is not a large end effector, the design 
of the torque measurement system must have certain size constraints. However, the 
problem was exactly the same as the one described in the large model} analvsis. There- 
fore, by using the same block diagram and obtaining certain parameters from the catalog 
and from related equations, the variable stiffness system can be adapted to a robotic 
finger joint. 

One of the main differences between the model used for experiments and the finger 
svstem was the dimensions of the beam. The beam, on which the strain gauges were 
mounted required careful design. Since a small beain was used in the design, to be able 
to get higher voltage, four small strain gauges were used. The size of the strain gauges 
was one of the main parameters which has an important effect on the design of the 


beam. 
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VIII. CONCLUSIONS 


|l. T he torque applied by an end effector to an object can be controlled by changing 
the stiffness of the servomechanism. 

2. Certain parameters must be added to the svstem block diagram to obtain an ac- 
curate model of the system in order to control the torque applied on the object. 

3. After adding the torque feedback to the system, the stiffness of the system will 
be a function of the feedback gain, while adding the torque feedback does not effect the 
system transient response. 

4. Even if the gearbox 15 nonbackdriveable, variable stiffness control of the 
servomechanism 1s possible. 

5. The variable stiffness concept may be easily applied to the design of a robotic 


finger tip. 


APPENDIX A. ME3802 LABORATORY EXPERIMENT 2 DC SERVO 
SYSTEM-SPEED CONTROL 


A. OBJECTIVES 

The purpose ol this experimentar to: 

l. Become familiar with the components of an electro-mechanical speed control 
system 

2. Use basic measurement equipment to perform experiments 

3. Measure the transfer functions of the components of the speed control system 


4. Perform a close loop speed control test of the system 


B. EQUIPMENT: 
For this experiment.you will need the following equipment 
l.Feedback educational servo system type 2515] 
2.Dual trace oscilloscope 
3.Digital voltmeter 
4.Chart recorder 
S.A stop watch 
6.Miscellaneous leads, wires and connectors 
Examine and familiarize vourself with the equipment, and determine how to operate 


and connect the various pieces together. 


C. METHOD 

l. Compare the close loop feedback control system shown in Figure 44 and 
Figure 45 with the schematic shown on the front panel of the servo system, 
Figure 46. Figure 44 shows the complete schematic, while Figure 45 shows only those 
parts that will be used in the experiment 2. Be sure to identify the correspondence be- 
tween all elements in both systems. Note the availability of certain system signals at the 
bottom of the front panel. 

2. The first part of the experiment deals with the identification of the various pa- 
rameters shown in Figure 45. Connect the system as shown in Figure 47, making sure 
the INTERNAL COMPENSATION switch is EN. Switch on, set input potentiometer 
0, to zero and use the SERVO AMPLIFIER and OPERATIONAL AMPLIFIER SE 
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ligure 44. — Position Control System Block Diagram 


ZERO controls to achieve no motor rotation with minimum motor current shown on thc 
panel meter. Ensure that the FEEDBACK SELECTOR switch 15 fully anti-clockwise. 

3. Tachometer Constant k, 

In this test, the output voltage from the tachometer is recorded for various speeds. 
The slope of the line of voltage plotted against speed then gives the tachometer constant 
in Volts/RPAL. Connect the system as shown in Figure 47, and set Pl to l and P2 to 1. 
With the digital volt meter connected as shown, turn the input potentiometer to obtain 
constant speed of rotauion of the motor. Using a stop watch, record the time for a given 
number of revelations (say 25). Note that the tachometer is mounted on the motor 
shaft, before the 30:1 gearbox driving the output potentiometer. Take this in to account 
when calculating the speed of the tachometer shaft. Change the setting of mput 
potentiometer and repeat the test to obtam a total of five readings. Plot voltage against 
speed, draw the best straight line you can and calculate the slope. The expected result 


should be about 0.00245 volts/ RPM. 


8 | 








Figure 45. Open Loop Speed Control Block Diagram 


4. Potentiometer Constant &,,, 

Connect the apparatus as shown in Figure 48, noting that the system is open loop. 
In this test we will determine the potentiometer constant 1.e. the relationship between the 
angular rotation of the potentiometer and the resulting voltage generated. Note that 
both input and output potentiometers are identical. Set the input potentiometer to point 
to zero degrees and record the error voltage. Rotate the input potentiometer from zero 
to 120 degrees in 20 degree steps. For each step record the voltage and subtract the 
voltage corresponding to zero degree position. Plot voltage against angular position and 
from the slope of the best straight line that fits the data determine k,,, The expected re- 
sult should be in the region of 5.7 volt/radian. 

5. Motor & Servo Gain K, 

This parameter is defined as the ratio of the output speed of the motor divided by 
the input voltage to the servo amplifier. Connect the system as shown in Figure 49, with 


P2 set to 0.7, and use the input potentiometer to establish a constant speed of the motor 
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shaft. Use the digital voltmeter to measure the input voltage to the servo amplifier and 
record this value. Determine the motor speed bv connecting the digital voltmeter to the 
VELOCITY socket, record the voltage and use the previouslv calculated value of 
tachometer constant A, to calculate the speed of the motor. Adjust the input 
potentiometer to give a different speed and repeat the test for five data points. Plot 
motor speed against input voltage and from the best straight line through the data points 
determine A,. The expected value 1s about 270 radians / see per volt. 

GC OOS lime Constant 7, 

In this test, the system 15 connected as an open loop speed control system, as shown 
in, Figure 50 subject to a step input. The step input 15 obtained from a function gener- 
ator Which should be set to provide a square wave output with a frequency of about 0. ! 
Hz, corresponding to a step input everv 5 seconds. Set P2 to 0.2. To avoid using exces- 
sive record paper, use the oscilloscope to observe the output speed and to qualitatively 
verify the response. The output should look similar to that shown in Figure 51. The 
purpose of the experiment 1s to determine the time constant of the exponential increase 
in motor speed in response to the step change in demanded speed. Once a trace similar 
to that shown in Figure 51. 1s observed, obtain a copy on the chart recorder bv switch- 
ing it on, adjusting the sensitivity, and recording a few input responses. Make a note of 
the time base for the chart recorder. The time constant is calculated bv determining the 
time taken for the system to achieve 63% of the demanded output, as shown in 
Figure 52. Measure the time constant from at least 3 response curve and calculate the 
average value. The expected time constant is 7,, — 0.25seconds. 

7. Connect the svstem as a close loop feedback control svstem as shown in 
Figure 53. Set P1 to l. All parameters shown in Figure 44 on page 81 are now known 
except for the gain &,. For the servo system this gain 1s actually the product of the op- 
erational amphfier gain and the value of the potentiometer P2. Note that P2, being a 
potentiometer, is actually an attenuator and hence its gai components must be less than 
unity. When socket B is connected to socket E, the gain of the operational amplifier is 
І, while connecting B to F reduces the gain to 0.1. Set P2 to I and perform a close loop 
step response as described in the previous section for the open loop. Observe the results 
on the oscilloscope, and make a sample chart recording output to determine the time 
constant the closed loop svstem. Bv analvzing the close loop transfer function together 
with the experimental values obtained, calculate a theoretical time constant for the close 


loop step response, and compare it with the measured values. 
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Equipment Configuration 


Figure 48. 
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